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ABSTRACT 


The Marine Corps and Army are developing a 
Position Locating Reporting Systen to aid the 
battlefield commander in locating his assets during 
battle. 


This study has applied Extended Kalman Filtering 
technigues to that problem, evolving from a_e simple 
Extended Kalman Filter Observer to three moving 
observers, whose position is uncertain, estimating the 
position cf another unit. 


‘2 


ble 
8.44 
a 


of oS 


i ove 
i¢; % erie a 


ay 


aoisilaes ~ 


> Bileite lrisd 
: .olsrnd 


2idt 
‘tien, tad ot esupiadoes 
0 sardine Lon bebootxs 


©? 
sd me ist: Paeod si weds ionn Se0dv .edevusedo 


ameale 


ine se#30ne to aoisizog 


=e - — 


TABLE OF CONTENTS 


BES. OF FIGURES. eeensieaeseseeneenrtenstenvrmeeteeneensteesteeeeenseneespesese 
LIST OF TABLES. eeseeestseeeenseeeeeeeeseespeseeeeeeeenteeeeneene 
ACKNOWLE DGEMENTS. eseeeeeneeseeeeenteseeeeeesteaeseeneteeteensespseseee 


I. 
II. 
iit. 
IV. 


V. 


INTRODUCTION. cc. ccc ccc ce ccccccccccccccccscces 
EXTENDED KALMAN FILTERING... ce ee ee ee cece cece 
CHOOSING THE BEST RANGER... ce ee eee ec eee cee see 
PLRS SIMULATION. . cee cc cc cece cece cc ccwcccccs 
A. TWO RANGING UNITS... ccc cece cece ccseces 
B. THREE RANGING UNITS. cc cc cece cccrccsceec 
C. RANGING UNITS IN MOTION... cee ec eeeeene 
D. SOURCE OF MEASUREMENT NOISE... ccceeecee 
CONCLUSIONS cece cc cc cc cece ce cece cesccscccccc 


COMPUTER PROGRAM. seoeeteeeeseeeeee7#*#nstentensteeeesteesenseeenseenenee8e2 8 
Base OF REFERENCES eseepseeneteeaeneeesteeaeenstseeneteesteaeeee@eneseaeesenee 
INITIAL DISTRIBUTION iB Sie ee eseeeneensteenseeeeeteeseeeseseeneeeeee 


eee oF 


LIST OF FIGURES 


Consecutive Updates Will Reduce the Degree of Uncertainity 
mrune Direction of the Ranging Unit-.....-.-.-.:er. eee 


PLRS Simulation - A Jet in a Constant 10Km Radius Turn 
Flying Between Two Stationary Rangers .......... 


PLRS Simulation - A Jet in a Constant 10Km Radius Turn 
Flying Among Three Stationary Rangers .......... 


PLRS Simulation - A Jet in a Constant 10Km Radius Turn 
Flying Among Three Moving Rangers ............ 


The Geometry of the Covariance of Measurement Noise 
RN Raa HT go aa we ee ee ee 


PLRS Simulation - A Jet in a Constant 10Km Radius Turn 
Flying Among Three Moving Rangers With Position 
Pe CUCM ss ioe) st ew cel Oe ee ee ws 


1] 


21 


24 


28 


32 


33 


LIST OF TABLES 


The Ranger Chosen at Each Time for the Two Stationary 
WON eS ee a OR en 8 ek ee we 


The Ranger Chosen at Each Time for the Three Stationary 
eee eaieila: 10 ieee and 2. 2% Rick + « - 2 es ee 


The Ranger Chosen at Each Time for the Three Moving Ranger 
SHOUUREIL dear. cenraad@ar,. «vi shes tO «athnevied«s: + 


The Ranger Chosen at Each Time for the Three Moving Rangers 
Wath. Position Uncertainty Simulations aa ccacietam® ec b> 


22 


25 


29 


34 


‘iiolieaemalie 
secant wae 7 


ACKNOWLEDGEMENTS 


The author wishes to acknowledge the assistance of 
Professors H. A. Titus and D. E. Kirk. 


The author, moreover, wishes to acknowledge the love 
and sacrafices that he recieved from his wife, Pam, and 
children, Marc and Jennifer, while he conducted this study 
and hereby dedicates this Thesis to then. 


, is 7 cs © 
te | 
| 
a i a 
ey nn 
a = 
iw, / 
= a BTHEMSACEIVOLXDS 


ona @Pbedvockss 04 eededy s0HIms off 4) 
¥ ATLA .2 60 bos OOOET 2 GH 


. a 


> ; 
| 2% pnts O27 @6deiv ,Istoeies ,saisus oat 
gStav eit 9072 voio : 258 
; & ao be Si St abet eenthas y 


ci y - : L 
2a “Betsubaoo eo slidiv ,7Ysiingst bos s288 192 


7) ~Wh 


eG907 OF Siasit eidd essevibheb ¥ 


>. Poa At a 7 


The precise location of all assets in and about the 
battle area is of prime importance to the tactical Marine 
Commander. In the past locating has had to depend on the 
individual knowing hjis own position and being able to report 
it through radio links to higher command. This system 
suffered from the limitations of terrain, daylight, weather, 
and the volume of radio traffic during battle. 


To alleviate these shortcomings the Marine Corps and 
Army are investigating a Position Locating and Reporting 
System (PLRS) to collect, process, and, display the location 
of units, vehicles, and aircraft in and about the battle 
area. 


The PLRS consists of field units and a master unit. The 
field unit is compact enough to be carried in the field by a 
man, vehicle, or aircraft. These units will determine the 
range to other field units in the area and report this 
information to the master unit for processing and display, 
The range information is determined by measuring the time 
required to send a signal from one unit to another and back 
again plus some "system" delay. When a unit's position is 
being updated it is referred to as the " Update" unit; and 
all others are referred to as "Ranging" units. 


In a previous study in this area,{1], tests were 
conducted to investigate the use of the error ellipse in 
visually displaying the degree of uncertainty of the 
position of an update unit and the effect of numerous 


updates on reducing that degree of uncertainty | It was 
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found that the degree of uncertainty is reduced in the 
direction of the ranging unit with consecutive updates as 


shown in Fig 1 taken from that study. 


That study also simulated one jet aircraft flying Mach 1 
in a constant radius turn as an update unit being ranged on 
by two stationary ranging units to explore the proper random 
forcing excitation covariance necessary for adequate filter 


performance. 


It is the intent of this study to further expand the 
Simulation begun in the previous work by adding an 
additional ranging unit, allowing the movement of the 
ranging units, and considering the effect of ranging from a 


unit whose position is not known exactly 
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Figure 1 —- CONSECUTIVE UPDATES WILL REDUCE THE DEGREE OF 
UNCERTAINTY IN THE DIRECTION OF THE RANGING UNIT 
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The Extended Kalman Filter is widely documented and no 
attempt at a development of that theory will be made in this 
work. A brief treatment has been included to establish 
nomenclature and formulas used. For a nore complete 
development one is referred to reference (2] or similar 


Texts. 


As defined in this work, PLRS is described by a set of 
discrete, linear, cartesian system equations 


x(k+1) = O(k) x(k) + I(k) _w (k) i 


and a set of discrete non-linear measurement equations 


_Z(k) = m(x(k),k) + v(k) (2) 


where ® and [Tf are linear functions and m is a nonlinear 
function of the state variables x(k); w(k) is the excitation 


noise and v(k) is the measurement noise of the system. 


The plant noises are considered uncorrelated, zero-mean, 
and white. 


The non-linear measurement equations can be linearized 


by expanding equation (2) around the best estimate at time k 
and using the first-order terms yielding 
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z(k) = H(k) x(k) + (Kk) 


where 


x (k/k) is the estimated value of the state at k after 
th x 
the k measurement and x(k/k-1) is the predicted value of 


th 
the state at time k before the k measurement. 


The state error vector is 
K'(k/k) = x(k/k) - x(k) 
and the predicted error vector is 


x" (k/k-1) = x(k/kK-1) - x (k) 


The covariance of the state error matrix is 


a -~ T 
P(k/k) = EL x" (kK/k) x" (kK/k) J 


and the predicted covariance of the state error matrix is 


g ~ 7 
P(k/k-1) = E(x" (k/k-1) x" (k/k-1)] . 
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The state excitation matrix is 


: T T 
Q(k) = ELLE (k) w(k) wo (k) PT (k)] 


and the measurement noise covariance matrix is 


T 
R(K) = ELw(k&) 2 (k)] .- 


The equations that made up the Kalman Filter used 
this work are as follows: 


T 
P(k/k-41) = $(k) P(k/k) & (kK) + Q(k) 


f i -1 
G(k) = P(k/k-1) H (k)[H(k) P(k/k-1) H (k) + R(k) ] 


P(k/k) = [I - G(k) H(k) JP (k/k-1) 
x (k/k) = x (k/k-1) + G(k)CZ(k) - H(k) x(k/k-1) J 
K(k/k-1) = $(k) £(k/k) 


z(k) = m(x(K/kK-1) ,k) 


in 


Since the only observations in this system are ranges, 
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the observation equation is 


1/2 
z (kp) = [x#(k) + y2(k) ] ; 


and from equation (3) we get 


x (k) y (k) 


a(k) = —-——— 9 
x2(k) + y? (k) x(k) + y2(k) 


The covariance of estimation error,?, is and expression 
of the uncertainity in the estimation of the states. 
Considering only the estimation's position error, P 


position 
can be expressed as 
eo 16 eK fi 
x xy 
4 > mee = 
-_pasition 
2 
OyO oO 
Y* eg 
Since the position estimation error is normally 


distributed, a curwe of constant error probability can be 
defined by using the exponent of the normal distribution, 


xé 2r. ZY y2 
xy 

eee ye Er) aoe 

ax (Omen) EG 

x x y y 
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This curve defines an ellipse. Graphically, for the given 
probability, the estimation may be anywhere in that ellipse. 
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To move from a simple Kalman Filter observer to the PLRS 
model, the first probiem encountered was to choose the best 
Tanger from which to take the measurement. In the previous 
work ,{1], it was shown that the most useful measurement, 
the one causing the most reduction in the error ellipse, is 
obtained by observing the update unit from a point aligned 
with the major axis of the error ellipse of the update unit. 


To find the ranger most closely aligned with the major 
axis of the update unit's error ellipse the orientation of 
the error ellipse must first be found using the following 
equation. 


2 Cov (x,y) 


= 2 
Oy oy 


3 = i°*tan-= 
+ 2 


This angle(8) gives the angle between -90° and 90° that the 
x-axis of the ellipse makes with the x-axis of the 
co-ordinate system. Looking at the ellipse in this new 
posture one can find the new "Uncorrelated" variances that 


define the major and minor axes. 


Ag Sie ace EG 


x z Sin 2¢ 


oe a<- #.g => Cov (z,y) 
es IG eet i ee 


y 2 Sin 2° 
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If og? is greater than g? the x-axis of the error ellipse 
x 


Y 
is the major axis and § is the angle we seek. If ,?2 is 
y 
greater thang? them the y-axis of the error ellipse is the 
x 


major axis and the angle we seek is 9+90°9. 


The bearing of the update unit from the ranger must then 
be found and it is simply 


The absolute value of the difference between 6 after 
proper correction, and 8 was chosen as the best alignment 
indicator; but to be aligned and to be 180° out of alignment 
is of equal value; therefore the absolute value of the 
cosine cf the differences was used as the alignment 
indicator and the ranger found to have the largest indicator 


was chosen as the ranging unit for that measurement. 
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A. TWO RANGING UNITS 


In previous work,[{1], the PLRS simulation was setup for 
a jet aircraft flying Mach 1 in a constant 10 Km turn about 
the origin to act as the update unit for all measurements. 
Two stationary ranging units were placed at the origin and 
at 10Km north, 10Km east. Using a one second sample 
interval, the jet was described by the following matrices: 


Its initial state was 
0 
0.333 Kmn/s 


lx 
iN 


10 Kn 
0 
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Its initial covariance of error matrix, measurement noise 
covariance, and excitation forcing matrix were 


-4 -4 
10 0 10 0 
-4 
0 10 0 0 
P(1/0) = 
-4 -4 
10 0 10 0 
-4 
0 0) 0 10 
and 
-4 
R = 10 
with 
-5 —- 
2. 5x40 5x10 0 0 
-5 -4 
5x10 10 0 0 
Q = 
-5 - 
0 0 265x710 Sz 10 
“5 = ig. 
0 0 5x10 10 


Fig 2415 a display of its final runs. The filter 
tracked accurately andthe error ellipses shown are twenty 
times their actual size to make them visible. Table 1 shows 
which was the ranging unit at each measurement time. 
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Figure 2 - 


RANGER -1- 


RANGER -2- @ 


5Km & 10Km 


PLRS SIMULATION ~ A JET IN A CONSTANT 10KM 


RADIUS TURN FLYING BETWEEN TWO STATIONARY RANGERS 
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TIME RANGER TIME RANGER TIME RANGER 


1 2 21 2 41 3 
2 1 22 i 42 2 
3 2 23 2 43 1 
4 l 24 l 44 2 
5 2 25 1 45 i 
- 1 26 2 46 2 
7 2 27 1 47 1 
8 1 28 2 48 2 
9 2 29 1 49 rf 
10 1 30 2 50 2 
11 2 31 l 51 1 
12 1 32 2 52 2 
13 2 33 1 53 1 
14 1 34 2 54 2 
15 2 35 1 55 1 
16 1 36 2 56 2 
17 2 37 1 57 i 
18 1 38 2 58 2 
19 2 39 1 59 1 
20 1 40 2 60 2 
TABLE 1 - THE RANGER CHOSEN aT EACH TIME FOR THE PLRS TWO 


STATIONARY RANGER SIMULATION 


22 


Bo 


eee ek 


“vs 


B. THREE RANGING UNITS 


The first step of this study was to add a third ranging 
unit at O north, 10Km east. The algorithm was enlarged to 
include the additional unit and its comparison with the 
alignment indicators of the other ranging units. 


It can be seen in Fig 3 that the size of the error 
ellipses were reduced in size in the mid-range area where 
the jet and the two original units were in line; and the 


third ranger provides the triangular measurement. 


Table 2 shows the ranging unit chosen for the 
measurement at each time k. 
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Figure 3 - PLRS SIMULATION - A JET IN A CONSTANT 10KM 
RADIUS TURN FLYING AMONG THREE STATIONARY RANGERS 
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TABLE. 2 


RANGER TIME RANGER TIME RANGER 


2 


1 


2 


a1 2 41 1 
22 3 42 3 
23 2 43 ig 
24 3 44 3 
25 k 45 pL 
26 3 46 3 
27 i. 47 af 
28 3 48 2 
29 1 49 i 
30 3 50 2 
31 2 52 ua 
32 3 52 3 
33 1 53 1 
34 3 54 3 
35 1 55 a 
36 3 56 3 
37 E ay. iL 
38 3 58 3 
39 1 59 E 
40 3 60 3 


THE RANGER CHOSEN AT EACH TIME FOR THE THREE 
STATIONARY RANGER SIMULATION 


25 


eet iee ee ew 


wr 


. 


a 
a 
23 
ee 
& 
a 

¥E 
st 

Re 

06 


C. RANGING UNITS IN MOTION 


In the second step the rangers are given motion. The 
Tangers at the origin and at 10Km north, 10Km east were to 
move north and south respectively at 3Kts as infantrymen. 
The ranger at 0 north, 10Km east was to move west at 120Kts 
as a helicopter. Again using one second sample intervals, 
their motion was defined using discrete linear state 


equations 


x(k#1) = o(k) x(k) , 
where 


with the initial states shown below; 


0 
x = INFANTRYMAN 
0 
1.67x103 Kn/s 


10 


0 
x = INFANTRYMAN 


10 
-1.67x103 Kn/s 
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-5.555x102 Km/s 
x = HELICOPTER 


0 


It can be seen in Fig 4 that no system depreciation 
resulted from the motion of the rangers, Table 3 shows the 


ranging unit chosen for the measurement at each time, 
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Figure 4- PLRS SIMULATION - A JET IN A CONSTANT 10KM 
RADIUS TURN FLYING AMONG THREE MOVING RANGERS 
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TIME RANGER TIME RANGER TIME RANGER 


1 2 21 3 41 3 
2 ai 22 Z 42 1 
3 2 23 3 43 Z 
4 1 24 z 44 i 
5 2 25 3 45 2 
6 1 26 1 46 1 
7 2 aT 3 47 2 
8 1 28 E 48 1 
9 2 29 3 49 2 
10 t 30 £ 50 Ez 
11 2 31 3 3x 2 
12 1 32 1 a2 1. 
13 3 Te! 3 33 Z 
14 1 34 ul 54 aL 
15 3 35 3 35 2 
16 2 36 1 56 Ht 
17 3 37 3 < 2 
18 2 38 1 58 di 
19 3 39 3 ee, 2 
20 2 40 ¥ 60 i 
TABLE 3 = THE RANGER CHOSEN AT EACH TIME FOR THE THREE 


MOVING RANGER SIMULATION 
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D. SOURCE OF MEASUREMENT NOISE 


.In the above simulations the position of the ranging 
unit has been assumed to be exact; while in actual 
application the ranging units will have covariances of 
estimation error defining an error ellipse; and the ranging. 
unit might be anywhere within that ellipse. To bring this 
position uncertainty into the simulation, the radius of the 
error 2llipse along the bearing from the ranging unit to the 
update unit was defined as the covariance of measurement 
error. 


The equation for the radius of an ellipse is a function 
of the major axis, the minor axis, and the angle at which 
the measurement is made. To find the measurement noise 


Gevariance, of the ellipse radius, ,2* and ,2' must be 


x Y 
compared and the larger defined as Mj, the major axis, and 


the smaller defined as Mn, the minor axis. The angle,a , at 
which the radius is determined is measured from the major 
axis and thus is calculated as the difference between6 and 
8. Fig 5 shows the geometry of the calculation of the 
covariance of measurement noise. The equation for R and the 


radius squared of the ellipse is: 


Ky Sn 


Mj Sin2a0 + Mn Cos?#a 


It can be seen in Fig 6 that performance was improved 
slightly using the covariance of estimation error as the 


sole source of measurement noise. 
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Table 4 shows the ranger chosen at each time for the 


three moving rangers with position uncertainity simulation. 
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- © IS THE RADIUS OF THE ERROR ELLIPSE - r2 
IS THE COVARIANCE OF MEASUREMENT NOISE 
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TIME RANGER TIME RANGER TIME RANGER — 


1 2 Zi. 2 41 1 
2 1 22 3 42 2 
3 2 23 2 43 1 
- 1 24 S 44 E 
2 2 25 1 45 1 
6 | 26 3 46 Z 
7 2 27 1 47 1 
8 £ 28 a 48 2 
9 2 29 ul 49 Z 
10 3 30 3 50 2 
11 i 31 1 aL Al 
12 3 a2. 3 a2 2 
13 1 33 e a3 t 
14 3 34 3 54 2 
15 i 35 di 55 i 
16 3 36 3 56 2 
17 1 37 1 a di 
18 3 38 3 58 2 
19 2 39 1 59 u 
20 3 40 3 60 Z 
TABLE 4 - THE RANGER CHOSEN AT EACH TIME FOR THE THREE 


MOVING RANGERS WITH POSITION UNCERTAINTY SIMULATION 
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The placement of the third ranger showed the value of 
triangulation of the rangers. The closer to normal the 
bearings of the rangers are to each other, the better the 
results of consecutive ranges. 


The allowance for motion and the representation of the 
Tanger's position uncertainity as the source of measurement 
error were important steps toward full simulation of the 
system; and they were accomplished without degradation of 
performance. 


A better simulation may be to represent the neasurement 
error as the ranger's position uncertainty plus some system 


measurement error. 


Still to be accomplished is the ability to update all 
units at each ranging, and to provide a gating system that 
will demand more frequent updates for faster moving units 


and less freguent updates for slower units. 
A program listing of the three moving rangers with 


position uncertainity is. included with an annotated data 
deck. 
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